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1  Introduction 


A  kinematically  redundant  robot  manipulator  is  a  manipulator  that  has 
more  degrees  of  freedom  than  are  necessary  to  locate  the  end  effector  at  a 
desired  position  and  orientation.  For  example,  if  we  want  to  locate  some 
point  on  a  two-dimensional  end  effector  at  a  specified  position  and  ori¬ 
entation,  we  need  three  degrees  of  freedom.  Thus,  a  robot  manipulator 
with  more  than  three  degrees  of  freedom  is  kinematically  redundant  in  the 
two-dimensional  space. 

The  mayor  advantages  to  adding  redundant  degrees  of  freedom  to  a 
robot  manipulator  are  as  follows: 

1.  One  achieves  greater  dexterity  in  maneuvering  in  a  workspace  with 
obstacles. 

2.  One  can  avoid  singular  configurations  of  the  manipulators. 

1.1  The  Resolved  Motion  Method  vs.  the  Inverse 
Kinematic  Method 

Because  of  these  significant  advantages,  an  increasing  amount  of  research 
has  focused  on  the  kinematically  redundant  manipulator,  and  the  progress 
in  this  field  has  been  rapid  [Whitney, 1972;  Li6geois,1977;  Klein  and  Huang, 1983 
Yoshikawa,1984;  Hollerbach,1984|.  Much  of  this  research  has  involved  the 
resolution  of  motion  using  the  pseudoinverse  of  the  Jacobian  matrix  —  also 
known  as  the  Moore-Penrose  generalized  inverse  matrix  —  in  order  to  re¬ 
solve  the  redundancy.  This  resolved  motion  technique  first  determines  the 
joint  velocity  using  the  pseudoinverse  matrix,  and  then  incrementally  de¬ 
termines  the  joint  displacement;  it  thus  transforms  from  workspace  to  joint 
space  via  joint  velocity.  In  contrast  to  this  direction  of  research,  relatively 
little  research  [Benati  et  al,1982;  Hollerbach,1984]  has  involved  the  inverse 
kinematics  —  the  direct  mapping  from  the  workspace  to  the  joint  space  — 
for  kinematically  redundant  manipulators. 

The  advantages  and  disadvantages  in  the  inverse  kinematic  method  over 
the  resolved  motion  method  are  well  known  in  nonredundant  robot  manip¬ 
ulators.  The  resolved  motion  method  —  now  using  the  inverse  of  the  Jaco- 


bian  matrix  instead  of  the  pseudoinverse  matrix  —  is  well-defined  for  gen¬ 
eral  manipulator  kinematics,  except  for  numerical  problems  near  kinematic 
singularities.  Furthermore,  the  joint  velocities  can  be  efficiently  computed 
from  the  workspace  velocities  using  the  Jacobian  matrix  without  requiring 
an  explicit  matrix  inverse.  The  resolved  motion  method,  however,  has  some 
weak  points: 

•  The  method  has  intrinsic  inaccuracy  because  of  linear  approximation 
characteristics  of  the  Jacobian  matrix;  thus  it  accumulates  errors, 
which  become  even  larger  as  the  velocity  increases. 

•  The  method  does  not  give  directly  the  joint  values  for  a  given  position 
and  orientation  of  the  end  effector. 

On  the  other  hand,  the  inverse  kinematic  method  has  symbolic  solutions 
only  in  some  types  of  manipulator  kinematics  [Pieper,1969].  For  general 
manipulator  kinematics,  it  has  only  iterative  solutions  based  on  numerical 
methods,  which  can  be  computationally  expensive  unless  we  have  initial 
conditions  sufficiently  near  to  the  solution.  However,  this  method  —  be  it 
symbolic  or  numerical  —  is  attractive  because  of  the  direct  mapping  from 
the  workspace  to  joint  space,  fixing  most  of  the  aforementioned  problems 
of  the  resolved  motion  method. 

1.2  Inverse  Kinematic  Method  in  the  Redundant 
Manipulator 

The  comparison  between  the  two  methods  remains  essentially  unchanged 
in  redundant  robot  manipulators;  thus  we  have  good  reasons  to  choose  the 
inverse  kinematic  method. 

As  in  the  nonredundant  case,  no  symbolic  solution  has  been  developed 
yet  for  the  general  redundant  manipulator,  for  we  cannot  obtain  symbolic 
solutions  unless  certain  conditions  are  met  by  the  manipulator  structure. 
For  example,  in  [Benati  et  al,1982;  Hollerbach,1984j  only  some  of  the  joint 
variables  were  obtained  symbolically.  To  obtain  these  solutions  the  ma¬ 
nipulator  structure  and  the  number  of  degrees  of  freedom  were  fixed  — 
explicitly  in  [Hollerbach,1984]  and  implicitly  in  [Benati  et  al,1982]. 


An  additional  difficult  task  for  a  redundant  manipulator  —  regardless 
of  whether  or  not  it  has  symbolic  solutions  —  is  to  rationally  (or  optimally) 
use  the  extra  degrees  of  freedom  to  achieve  the  objectives  such  as  singularity 
avoidance  or  obstacle  avoidance.  In  other  words,  the  task  is  to  resolve  the 
redundancy  while  achieving  some  objectives. 

To  our  knowledge,  the  general,  closed-form  equation  to  resolve  the  re¬ 
dundancy  at  the  inverse  kinematic  level  has  not  appeared  yet.  In  thiB 
paper,  we  propose  a  method,  or  a  general  equation  —  derived  from  the  La- 
grangian  multiplier  method  —  to  resolve  the  redundancy;  thus  fully  spec¬ 
ifying  the  kinematic  equations.  The  resulting  system  of  equations  will  be 
qualitatively  compared  with  the  two  existing  methods:  the  extended  Ja¬ 
cobian  method[Baillieul,1985]  and  the  resolved  motion  method  [Li6geois 
,1977;  Klein  and  Huang,1983],  which  uses  the  pseudoinverse  matrix.  From 
this  comparison,  the  relationships  between  the  proposed  method  and  each 
of  the  two  methods  will  be  examined.  To  numerically  evaluate  the  proposed 
method,  the  system  of  equations  —  which  requires  numerical  iterative  so¬ 
lutions  —  is  solved  for  a  simulated  task,  and  its  solutions  are  compared 
with  those  of  the  resolved  motion  method. 

In  Section  2,  the  proposed  method  will  be  derived.  In  Section  3,  the 
comparison  and  the  relationships  will  be  covered.  The  proposed  method 
will  be  evaluated  by  simulations  in  Section  4,  and  the  results  will  be  dis¬ 
cussed  in  Section  5,  and  conclusions  in  Section  6. 

2  Derivation  of  the  Proposed  Equation 

In  this  section,  we  will  derive  extra  equations  which,  together  with  the  kine¬ 
matic  equations  of  the  manipulator,  can  fully  specify  the  under-determined 
problem. 

The  kinematic  equation  for  the  redundant  manipulator  is  given  as  the 
following  vector  equation: 

x  =  f(0)  (1) 

where  x  is  an  m-dimensional  vector  representing  the  position  and  orien- 
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tation  of  the  end  effector  in  the  workspace,  0  is  n-dimensional  vector  rep¬ 
resenting  joint  variables,  and  f  is  a  vector  function  consisting  of  m  scalar 


functions,  with  m  <  n.  Eq.(l)  may  be  rewritten  as 

F«  =»(*>-*  (lo) 

Let  -H'(fl)  be  some  criteria  function  to  be  minimized,  which  quantitatively 
represents  the  desired  performance  —  for  instance,  singularity  avoidance  or 
obstacle  avoidance.  Here,  any  criteria  function  can  be  used,  as  long  as  the 
function  is  expressed  in  terms  of  joint  variables  —  which  is  easy  in  most 
cases  by  using  Eq.(l)  —  and  the  function  has  first  partial  derivatives. 

Let  us  define  the  Lagrangian  function  L{0)  as  the  following: 

L(0)  =  ATF(0)  +  H(0)  (2) 

where  A  is  an  m-dimensional  Lagrangian  multiplier  vector.  At  the  minimum 
of  L, 
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57-^jy  +  sr  (3) 

where  the  m  x  n  matrix,  is  the  Jacobian  matrix  J.  The  second  term  in 
the  r.h.s.  of  Eq.(3)  may  be  expressed  as 


hr  = 


where  h  =  {hl,h7,...,hn)T  with 


t  dH 

hi~  dOS  ~1>2«”»n) 


Thus  Eq.(3)  becomes  the  following: 


ArJ  =  -hJ 


If  we  transpose  Eq.(4),  we  get 


'-'»>»>  r. 


where  (J*)r  denotes  the  transpose  of  t-th  column  vector  of  the  Jacobian 
matrix.  If  we  select  m  linearly  independent  rows  from  Jr,  which  are,  with¬ 
out  loss  of  the  generality,  the  first  m  rows,  and  constitute  a  nonsingular 
matrix,  Jm,  then  A  can  be  obtained  from  Eq.(5),  as 


‘  A,  ‘ 

'  A*  ' 

Aj 

A, 

• 

=  "Jm1 

• 

• 

• 

.Am. 

.  Am. 

Substituting  this  into  Eq.(5),  we  have 


(jm+J)r 

* 

Jm'1 

-«s  •£*  • 

—  _ 

Am+i 

Am+l 

.  (J;)T  . 

.Am. 

.  A„  . 

For  simplicity,  let  us  denote 

■  (jm+ljT  "I 

( Jm+i)T 


(Jn)T  J 


(6) 


where  3n-m  is  an  (n  —  m)  x  m  matrix.  If  we  define 


Z 


(6a) 


where  IB_m  is  an  identity  matrix  of  rank  (n  —  m),  then  Eq.(6)  becomes 


Zh  =  0 


(7) 


where  Z  and  h  are  defined  as  above.  If  we  combine  the  kinematic  equation, 
Eq.(l),  with  Eq.(7),  as  a  system  of  equations,  we  get 


x  =  f  (•) 

Zh  =0 


(7a) 


Since  Z  is  an  (n  —  m)  x  n  matrix,  and  h  is  an  n-dimensional  vector, 
Eq.(7)  consists  of  (n— m)  scalar  equations  with  n  unknowns,  0.  On  the  other 
hand,  the  kinematic  equation,  Eq.(l),  has  m  scalar  equations.  Therefore, 
Eq.(7a)  has  n  independent  nonlinear  equations  which  now  fully  specify  the 
n  unknowns.  Note  that  Eq.(7a)  has  to  be  solved  numerically. 

The  additional  set  of  equations,  Eq.(7),  resolve  the  redundancy  —  at 
the  inverse  kinematic  level  —  in  such  a  way  that  the  criteria  function, 
■ff(fl),  may  be  minimized.  This  resolution  of  redundancy  may  be  viewed  as 
the  direct  counterpart  of  the  resolution  technique  in  the  resolved  motion 
method,  which  uses  the  null  space  to  resolve  the  redundancy.  We  will 
discuss  the  relationship  in  more  detail  in  the  subsequent  section.  Note  the 
generality  of  Eq.(7);  no  assumption  was  made  that  could  limit  it. 


3  Comparison  with  Other  Methods 

In  this  section,  the  present  result  in  Eq.(7)  will  be  compared  with  two 
existing  methods:  the  extended  Jacobian  method  and  the  resolved  motion 
method  which  uses  the  pseudoinverse.  The  relationships  will  be  investigated 
on  the  basis  of  comparisons. 

3.1  Relationship  with  Extended  Jacobian  Method 

An  alternative  method  to  resolve  the  redundancy  —  also  at  the  inverse 
kinematic  level  —  is  presented  in  [Baillieul,1985j.  This  method  derives  the 
additional  equations  by  using  the  orthogonality  between  the  gradient  vector 


•  .  •  V-  . 
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of  the  criteria  function  and  the  null  space  vector,  n j,  such  as 


G{0)  =  njh  ^ 

where 

nj  —  (At,  A},..,  An)  (9) 

with 

A,  =  J*+1,..,  Jn)  (10) 

and  where  Jk  is  the  Jfc-th  column  vector  of  the  Jacobian  matrix.  From 
the  resulting  fully  specified  system  of  equations,  the  new  Jacobian  matrix, 
called  the  extended  Jacobian,  is  derived,  just  in  the  same  way  as  in  the 
nonredundant  case. 

This  method,  however,  is  limited  to  redundant  manipulators  that  have 
only  one  redundant  degree  of  freedom,  that  is,  only  if  n  =  m+1.  Obviously, 
this  limitation  is  not  desirable. 

As  proved  in  Appendix  A,  the  additional  equation,  Eq.(8)  can  be  also 
obtained  from  Eq.(7)  in  the  case  that  n  =  m+ 1.  Therefore,  we  may  regard 
Eq.(7)  as  a  general  equation  from  which  Eq.(8)  could  be  derived. 

Moreover,  as  Eqs.(9)  and  (10)  show,  elements  of  nj  are  the  determi¬ 
nants  ofnmxm  submatrices  made  from  the  original  Jacobian  matrix  — 
making  n  different  combinations  from  n  column  vectors,  and  obtaining  n 
determinants.  Compared  to  this,  however,  Eq.(7)  has  only  one  inversion  of 
an  m  x  m  matrix;  accordingly,  it  is  somewhat  easier  to  manipulate  either 
symbolically  or  numerically. 

Therefore,  we  may  say  that  Eq.(7)  is  the  more  general  equation  with 
expressions  somewhat  simpler  to  treat  and  more  efficient  to  compute  than 
Eq.(8). 


3.2  Relationship  with  Pseudoinverse  Control 

A  general  solution  for  the  equation 


when  »  >  m,  was  given  as  [Ben-Israel  and  Greville,1980] 

0  =  J+x  +  (I  -  J+ J)h  (11) 

where  J+  is  the  pseudoinverse  matrix,  defined  as 

J+  =  JT(JJT)-1  (12) 

and  (I  —  J+J)  is  the  null  space  of  J,  with  h  an  arbitrary  vector.  Eq.(ll) 
gives  a  way  to  resolve  the  redundancy  at  the  velocity  level. 

Liegeois[l977]  developed  a  formulation  of  resolution  of  redundancy,  such 
that  a  scalar  criteria  function  may  be  minimized,  by  setting  the  vector  h 
as 

h  =  V#  (12a) 

where  H  is  the  criteria  function  to  be  minimized.  He  expresses  Eq.(ll)  and 
Eq.(12a)  in  terms  of  the  infinitesimal  displacement,  as 

d0  =  J+dx+(I-J+J)  Vfi  (13)  igf 

In  Eq.(13)(or  Eq.(ll)),  the  first  term  in  the  r.h.s.  is  responsible  for  the 

displacement  of  the  end  effector.  The  second  term,  on  the  other  hand, 
forces  joints  to  have  self-motion  to  achieve  an  equilibrium  (or  optimum), 

$*,  where  H  has  a  local  minimum,  for  an  instantaneous  location  of  the  end 
effector,  x(t).  In  practice,  however,  while  the  joint  variables  are  searching 
for  a  6*  for  a  given  x,  x(t)  continuously  varies  —  thus  requiring  different 
0*' s.  Therefore,  the  joint  variables  never  reach  the  optimal  configuration, 
but  are  slightly  different  from  that  configuration  in  the  direction  determined 
by  the  first  term  in  Eq.(13),  J+dx. 

Because  of  these  characteristics,  the  resolved  motion  method  in  Eq.(13)(or 
Eq.(ll))  has  an  undesirable  property:  it  does  not  preserve  repeatablity  of 
joint  values  for  repeated  end  effector  motions.  More  specifically,  two  factors 
that  cause  this  property  are  as  follows: 

1.  Because  of  the  directionality  in  the  first  term  of  Eq.(13),  the  joint 
variables  have  different  values  depending  on  the  direction  of  the  re¬ 
peated  path  —  a  cyclic  path,  for  instance  —  in  the  workspace.  Note, 
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A>. 


JtV. 


however,  that  the  repeatablility  can  be  preserved  when  tracing  only 
one  direction  of  the  cyclic  path  even  in  the  presence  of  this  factor 
[Baillieul,1985j. 


2.  Because  of  the  irreversibility  of  the  second  term,  they  never  return  to 
the  original  configuration,  once  the  joint  variables  achieve  a  O’ .  This 
situation  can  happen  at  the  initial  transient  period  when  initial  joint 
values  are  far  from  the  optimum;  for  the  optimal  joint  values  cannot 
be  known  in  advance. 

In  Appendix  B,  we  prove  that  Eq.(7)  is  the  necessary  and  sufficient  condi¬ 
tion  to  be  satisfied  when  Eq.(13)  reaches  its  equilibrium  states  with  dx  =  0. 
In  other  words,  Eq.(7a)  gives  the  exact  equilibrium  state  at  which  Eq.(13) 
will  eventually  arrive  —  the  optimal  joint  configuration  —  for  a  given  end 
effector  location.  Thus,  we  may  regard  Eq.(13)  in  the  resolved  motion 
method  as  an  approximated  equation  linearized  at  states  that  are  exactly 
determined  by  Eq.(7a). 
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Simulation 


In  this  section,  we  select  a  kinematically  redundant  manipulator  and  apply 
Eq.(7).  The  resulting  system  of  equations  are  solved  numerically  for  x, 
the  end  effector  location,  which  makes  a  cyclic  path.  In  parallel  to  using 
Eq.(7a),  the  resolved  motion  method  is  applied  to  the  same  manipulator 
with  the  same  tip  motion.  The  points  we  try  to  examine  or  verify  through 
the  simulation  are  as  follows: 


1.  Whether  the  resulting  system  in  Eq.(7a)  gives  kinematically  correct 
joint  variables  for  a  given  x,  achieving  the  performance  represented 
by  the  criteria  function  we  select. 

2.  How  the  present  method  compares  to  the  resolved  motion  method  in 
terms  of  accuracy  and  repeatability. 

3.  Whether  the  present  method  gives,  in  fact,  the  same  equilibrium 
states  as  the  resolved  motion  method  will  eventually  reach. 
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Figure  1:  The  Schematic  Diagram  Of  The  Redundant  Manipulator 


We  use  the  same  manipulator  presented  in  the  paper[Yoshikawa,1984] 
for  the  sake  of  comparison  of  data  obtained  in  that  paper:  a  3  degrees  of 
freedom  manipulator  with  the  end  effector  moving  in  the  (x,y)  plane;  thus 
kinematically  redundant.  The  schematic  diagram  with  necessary  parame¬ 
ters  is  in  Figure  1. 

The  task  is  to  make  a  square  path  —  thus  a  cyclic  path  —  while  avoid¬ 
ing  singularities.  A  good  criteria  function  for  this  objective  may  be  the 
manipulability[Yoshikawa,1984],  which  is  given  as 

H  =  def(JJT)  (14) 

The  kinematic  equation  is  given  as 

X  =  liSi  +  l2S  12  +  IjilJJ  (15) 

1/  =  +  hcu  +  h^its  (16) 

where  li,l2,  and  l2  represent  the  length  of  each  link,  while  the  variables  with 
subscripts  are  defined  as 

Si  =  sin(0i),  Sij  .k  =  sin(0i  +  0,  +  ...  +  6k), 

Ci=cos{$i),  c,y...*  =  cos(6i  +  Oj  +  ...  +  0k),  =  1,2,3 


Then,  the  Jacobian  matrix  is  obtained  as 

j  —  (  veus  +  ucu  +  ei  vcijs  +  “Cn  wciM 

\  — OSlJS  —  ti«ij  ■+■  Si  *"®*1J3  —  US  12  — VSus 

where 


By  applying  Eq.(7),  we  get 

2u>vs(s3SsS3  —  clss|)  -f  uws(2s2sS2ss  -  3smss*s)  +  2uswjSjSjs+ 

U,W,(cS3  -  C2J)  +  2ut?J(s2S2jM  -  CjSjs)  -  USVS22«3  -  2uSV53*3  (18) 

=  0 

where  the  same  definition  is  used  for  the  subscripts  as  in  Eqs.(15)  and  (16). 

The  system  of  equations,  Eq.(15),  Eq.(l6),  and  Eq.(18)  now  fully  specify 
the  originally  under-determined  system  of  equations,  Eq.(15)  and  Eq.(16), 
while  minimizing  H  in  Eq.(14).  The  system  of  equations  may  be  solved 
either  purely  numerically,  or  by  symbolically  reducing  variables  —  in  this 
example,  6X  —  and  then  by  using  numerical  methods.  Incidentally,  this 
example  suggests  that  it  is  possible  to  reduce  variables,  thus  reducing  the 
order  of  the  system  of  nonlinear  equations,  after  resolving  the  redundancy 
first  with  all  the  joint  variables.  The  system  of  equations  were  numerically 
solved  for  joint  values,  tracing  each  (x,y)  on  a  square  command  path  in 
the  workspace  by  using  a  subroutine  called  ZSOLVE,  translated  from  the 
IMSL  library  into  MACSYMA.  As  shown  in  Figure  3,  the  x-y  coordinates 
of  the  four  vertices  of  the  command  path  are  given  as  follows: 

(446.00,  91.514), (546.00,  91.514) 

(446.00,-84.865)  ,(546.00,-84.865) , 
where  the  units  are  mm. 

Meanwhile,  the  resolved  motion  method  in  Eq.(ll)  is  also  applied  to 
this  manipulator  for  the  same  path.  Since  Eq.(ll)  is  a  system  of  differ¬ 
ential  equations,  a  FORTRAN  program,  called  DYSYS  —  which  uses  the 
Runge-Kutta  integration  method  —  was  used  together  with  the  LINPACK 
subroutines.  Note  that  this  numerical  scheme  allows  much  more  accurate 
solutions  than  the  normal  scheme  for  the  resolved  motion  method.  That 


is,  the  Runge-Kutta  method  evaluates  the  derivative  four  times  at  each 
time  interval  and  calculates  the  weighted  average,  while  the  normal  scheme 
evaluates  it  only  once  at  each  time  interval. 

The  simulation  for  the  resolved  motion  method  was  made  with  initial 
joint  angle  values  of  (-40.5006,  141.6408,  78.4169)  in  degrees,  which  are 
far  from  equilibrium  states,  that  were  deliberately  selected  to  examine  re¬ 
peatability.  The  same  initial  value  was  also  used  as  the  initial  guess  for  the 
above  nonlinear  equations  for  fair  comparison  of  the  two  methods. 

5  Results  and  Discussions 

5.1  Results 

The  numerical  results  of  simulations  are  listed  in  Figures  2-3  and  Tables 
1-3: 

•  Figure  2  is  the  plot  of  joint  variables  solved  with  the  two  methods. 
Note  that  the  3-D  trajectory  of  joint  variables  is  represented  with  two 
2-D  plots:  Bi  vs.  $2  and  vs.  0S. 

On  the  other  hand,  Figure  3  shows  actual  trajectories,  with  the  two 
methods,  of  the  end  effector  in  the  workspace,  as  compared  to  the 
command  path.  The  actual  trajectory  was  determined  by  forward 
kinematics  with  joint  values  obtained  by  each  method. 

•  In  Table  1,  some  representative  solutions  are  listed  to  numerically 
compare  the  accuracy  of  the  end  effector  position  obtained  with  each 
method,  while,  in  Table  2,  the  repeatability  was  examined  for  a  simple 
reciprocal  path. 

Table  3,  on  the  other  hand,  verifies  the  relationship  proved  in  Ap¬ 
pendix  B  :  the  solution  with  the  resolved  motion  method  when  dx  =  0 
is  the  same  as  that  with  the  proposed  method. 
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Figure  2:  The  Command  Path  And  Actual  Workspace  Trajectories 
Obtained  Witli  The  Two  Methods 


Table  1:  The  Comparison  Of  Accuracy  Obtained  With  The  Two 
Methods 


Command  Path 
Proposed  Method 
Resolved  Method 

Command  Path 
Proposed  Method 
Resolved  Method 

Command  Path 
Proposed  Method 
Resolved  Method 

Command  Path 
Proposed  Method 
Resolved  Method 

Command  Path 
Proposed  Method 
Resolved  Method 


X(mm) 

Y(mm) 

0i  (deg) 

0s  (deg) 

0s(deg) 

:  446.00 

91.514 

:  446.00 

91.514 

-25.5116 

134.4894 

100.8165 

:  446.00 

91.514 

-40.5006 

141.6408 

78.4169 

:  446.00 

-84.866 

:  446.00 

-84.866 

-13.4927 

135.1801 

101.6627 

:  445.74 

-65.824 

-14.0445 

135.3160 

101.2448 

:  546.00 

-84.866 

:  546.00 

-84.863 

-7.1232 

128.0020 

92.1837 

:  545.52 

-68.216 

-7.1924 

127.9635 

92.4919 

546.00 

91.514 

546.00 

91.514 

-17.0753 

127.4846 

91.4484 

545.73 

92.947 

-17.0519 

127.3890 

91.7938 

446.00 

91.514 

446.00 

91.514 

-25.5116 

134.4894 

100.8165 

445.97 

93.167 

-25.7427 

134.4867 

100.7127 

I 

* 

'v 


Table  2:  The  Repeatability  Test  With  The  Two  Methods 


X(mm) 

Y(mm) 

(deg) 

0j  (deg) 

0s  (deg) 

Command  Path 

446.00 

91.514 

Proposed  Method 

446.00 

91.514 

-25.5116 

134.4894 

100.8165 

Resolved  Method 

445.89 

93.140 

-25.7472 

134.4929 

100.7206 

Command  Path 

446.00 

-84.866 

Proposed  Method 

446.00 

-84.866 

-13.4927 

135.1801 

101.6627 

Resolved  Method 

445.63 

-66.244 

-14.0476 

135.3249 

101.2557 

Command  Path 

446.00 

91.514 

Proposed  Method 

446.00 

91.514 

-25.5116 

134.4894 

100.8165 

Resolved  Method 

445.60 

92.912 

-25.4178 

134.3821 

101.2799 

Command  Path 
Proposed  Method 
Resolved  Method 


446.00  -84.866 

446.00  -84.866  -13.4927  135.1801  101.6627 
445.57  -66.184  -14.0526  135.3293  101.2610 


Table  3:  The  Comparison  Of  Solutions:  Proposed  Method  Vs.  Re¬ 
solved  Method  With  dx=0 


Command  Path 
Proposed  Method 
Resolved  Method 

Command  Path 
Proposed  Method 
Resolved  Method 

Command  Path 
Proposed  Method 
Resolved  Method 

Command  Path 
Proposed  Method 
Resolved  Method 


X(mm) 

Y(mm)  0i  (deg) 

0,(deg) 

0s  (deg) 

:  446.00 
:  446.00 

:  446.00 

91.514 

91.514  -25.5116 

91.514  -25.5115 

134.4894 

134.4894 

100.8165 

100.8164 

:  446.00 
:  446.00 
:  446.00 

-84.866 

-84.866  -13.4927 
-84.868  -13.4927 

135.1801 

135.1801 

101.6627 

101.6626 

:  546.00 
:  546.00 
:  546.00 

-84.866 

-84.863  -7.1232 
-84.863  -7.1232 

128.0020 

128.0020 

92.1837 

92.1837 

:  546.00 
:  546.00 
:  546.00 

91.514 

91.514  -17.0753 

91.514  -17.0752 

127.4846 

127.4846 

91.4484 

91.4484 

5.2  Discussions 

From  the  results  of  simulations,  we  may  evaluate  the  proposed  method 
in  terms  of  accuracy  and  repeatability  by  comparing  it  with  the  resolved 
motion  method.  We  can  also  derive  some  useful  ideas  from  the  relationship 
between  the  two  methods. 

5.2.1  Accuracy 

As  shown  in  Table  1  and  Figure  3,  the  proposed  method  gives  joint  vari¬ 
ables  which  exactly  correspond  to  the  commanded  x  and  y,  minimizing  the 
criteria  function  to  avoid  singularities.  Clearly,  we  see  that  the  accuracy  in 
the  workspace  achieved  with  the  proposed  method  is  better  than  that  with 
the  resolved  motion  method. 

Therefore,  the  proposed  method  provides  a  useful  mean  for  an  accurate 
position  control  of  the  end-effector,  when  the  manipulator  is  kinematically 
redundant. 

U  5.2.2  Repeatability 

Table  2  and  Figure  2  show  that  the  repeatability  is  not  preserved  with  the 
resolved  motion  method  because  of  the  two  factors  mentioned  in  Section  3: 
the  initial  joint  variables  which  are  far  from  optimal  joint  values  (Figure 
2)  and  the  direction  —  clockwise  or  counterclockwise  —  of  the  path  to  be 
traced  (Table  2). 

The  lack  of  repeatability  can  be  a  considerable  drawback  in  robot  ma¬ 
nipulators  which  perform  cyclic  tasks,  because,  as  the  end  effector  traces 
the  cyclic  path,  joint  variables  evolve  into  states  which  cannot  be  predicted 
in  advance. 

On  the  other  hand,  it  is  obvious  that  the  proposed  method  preserves 
the  repeatability  regardless  of  direction.  In  other  words,  the  method  allows 
a  fixed  transformation  from  workspace  to  joint  space.  The  property  of 
fixed  transformation  is  useful  not  only  for  the  prediction  of  joint  variables, 
but  also  for  the  precomputation  of  position  dependent  terms  such  as  the 
Jacobian  matrix  and  the  inertia  matrix. [Raibert  and  Horn, 1978] 


18 


5.2.3  Relationship  between  the  Two  Methods 

The  result  in  Table  3  shows  a  nearly  perfect  agreement  of  both  solutions, 
verifying  that  Eq.(7)  in  the  proposed  method  is  the  equilibrium  equation 
at  which  Eq.(ll)  will  finally  arrive. 

Because  of  the  relationship  between  the  two  methods,  we  may  use  them 
interchangeably  as  follows: 

•  The  exact  equilibrium  state  can  be  determined  either  directly  with 
the  proposed  method,  or  indirectly  with  the  resolved  motion  method 
by  setting  dx  =  0.  The  latter,  however,  would  require  more  compu¬ 
tations  than  the  former. 

•  The  incremental  displacement  dOt  which  Eq.(ll)  in  the  resolved  mo¬ 
tion  method  easily  provides,  can  be  also  obtained  by  first  differenti¬ 
ating  Eq.(7a)  to  get  the  Jacobian  matrix  and  then  by  inverting  it. 

We  can  also  make  use  of  the  relationship  complementarily:  The  proposed 
method  could  be  more  effective  if  the  initial  guess  for  the  method  is  provided 
by  the  resolved  motion  method. 

6  Conclusions 

In  the  paper,  we  have  derived  a  general  equation  which  resolves  the  redun¬ 
dancy  in  the  kinematically  redundant  manipulator.  This  equation,  together 
with  the  kinematic  equations,  constitutes  a  system  of  equations,  the  solu¬ 
tion  of  which  generates  accurate  joint  values  which  make  the  end  effector 
trace  the  commanded  path  in  the  workspace,  while  minimizing  the  criteria 
function. 

We  have  compared  the  equation  with  two  other  methods.  We  have 
proved  that  the  equation  derived  is  a  general  equation  that  generates  the 
extended  Jacobian  method.  We  have  also  shown  that  the  proposed  system 
of  equations  is  an  equilibrium  equation  toward  which  the  resolved  motion 
method  converges.  This  point  was  proved  and  verified  in  the  simulation 
results.  The  results  of  simulation  also  show  that  the  proposed  method  gives 
better  joint  values  than  the  resolved  motion  method  in  terms  of  accuracy 
and  repeatability. 
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7  Appendix  A.  The  Derivation  of  the  Ex¬ 
tended  Jacobian  Method 


In  this  Appendix,  we  will  prove  that  the  extended  Jacobian  method  is,  in 
fact,  a  special  case  of  Eq.(7). 

The  additional  equation  to  resolve  the  redundancy  in  the  extended  Ja¬ 
cobian  method  is  given[Baillieul,1985]  in  Eqs.(8),(9),  and  (10)  as 


G(0)  —  njh 
=  0 


(8) 


where 

nj  =  (Ai,A2,...,A„)  (9) 

with 

A,  =  (-1  (10) 

and  where  Jk  is  the  k-th  column  vector  of  the  Jacobian  matrix,  J,  derived 
from  Eq.(l).  When  n  =  m  +  1,  our  result,  Eq.(7),  is  specified  as 


g2{0)  =[(J")rJm-,,-l)h 

=  0 


(Al) 


where  ( Jn)T  is  the  transpose  of  the  n-th  column  vector  of  the  Jacobian 
matrix,  J.  Jm_1  can  be  derived  as 


Jm'1  =  -pr-Am  (A2) 

where  Am  is  the  adjoint  matrix  of  Jm  and  Dm  is  the  determinant  of  Jm. 
Thus  Am  is  expressed  as 


Ajn  — 

(  Cofu 
Cofu 

Cof2l 

Cof22 

Cofm\  > 

•  •  •  Cofmi 

<  Cofim 

Cofim 

...  Co  f  mm  j 

(A3) 


where  Co  fa  is  the  cofactor  of  j\j  of  the  Jacobian  matrix,  J.  From  Eqs.(Al),(A2), 
and  (A3),  we  get 


y.' 

y.N 


(A4) 


where  A'm  is  the  t-th  column  vector  of  Am.  Since 

(Jn)T  Alm  =  jinCofii  +  hnCofii  +  ..  +  JmnCofu 
—  -Ai 

we  get  likewise 

=  -Ai 

From  the  definition  of  An,  we  get 

An  =  det(Jm^) 

=  det(Jm) 

=  Dm 


Therefore, 


Ai  A2 


Since  Jm  is  nonsingular  —  and  thus  An  is  nonzero,  we  can  multiply  by  it 
on  both  sides  of  Eq.(Al),  resulting  in  Eq.(8).  Thus  we  have  proved  that 
Eq.(7)  is  a  general  expression  which  yields  the  additional  equation  in  the 
extended  Jacobian  method. 

8  Appendix  B.  The  Relationship  Between 
The  Proposed  Method  And  The  Resolved 
Motion  Method 

The  matrix  in  Eq.(6a)  is  again, 

Z  =  [jn-mJm"1  :  -!»-«]  (6a) 

Since  the  rank  of  any  matrix  is  the  dimension  of  its  largest  nonsingular 
submatrix,  which  is  In_m  for  Z,  the  rank  of  Z  (and  ZT,  too)  is  n  —  m.  In 
addition,  since 

J JT  _  [J  T  .  1  Ti  (Jm  1)T(Jn-m  l)T 

JZ  -  Pm  •  J«-m  1  -In_m  (£1) 


I 

1 


•j»  *  •**  •*'  I  *  *  •  •  *  *  '  •  *  '•  ,%  #  • 
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column  vectors  of  ZT  are  a  set  of  basis  vectors  which  are  orthogonal  to  J. 
Thus,  row  vectors  of  J,  together  with  column  vectors  of  ZT  constitute  the 
basis  of  n-dimensional  vector  space. 

Accordingly,  any  n-dimensional  vector  h  can  be  represented  as 

h  =  Jrh,  +  Zrh,  (B2j 

where  hi  and  h2  are  arbitrary  vectors  of  m  and  n  —  m  dimensions,  respec¬ 
tively.  Premultiplying  Eq.(B2)  by  J,  we  have 


Jh  =  JJThi 


Thus, 


hi  =  (JJ^-'Jh  (5  3) 

Similarly,  if  we  multiply  Eq.(B2)  with  Z  and  solve  for  h2,  we  get 

h2  =  (ZZr)-1Zh  (54) 

From  Eq.(B2),  Eq.(B3),  and  Eq.(B4),  we  obtain  the  following  relationship: 

(I  -  JT(JJr)-1J)h  =  Zr(ZZr)"1Zh 


or,  from  Eq.(12), 


(I  -  J+J)h  =  Zr(ZZr)“lZh 


For  a  constant  location  of  the  end  effector  (no  tip  motion),  when  dx  =0, 
Eq.(l3),  with  Eq.(B5),  becomes 

d$  =  Zr(ZZr)-‘Zh  (56) 

If  Zh  =  0  as  in  Eq.(7),  then  from  Eq.(B6),  dfi  =  0,  which  means  that 
joint  variables  reach  an  equilibrium  state  —  or  a  stationary  state  —  which 
is  mostly  the  optimal  configuraion  for  a  given  tip  location.  Conversely,  if 
d0  =  0,  we  have  Zh  =  0;  since  the  rank  of  ZT(ZZT)-1  in  Eq.(B6)  is  n  —  m 
and  Zh  is  an  (n  —  m)-dimensional  vector. 

Therefore,  Zh  =  0,  Eq.(7),  of  the  proposed  method  is  the  necessary 
and  sufficient  condition  to  be  satisfied  when  Eq.(13)  of  the  resolved  motion 
method  reaches  its  equilibrium  state. 
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